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(54) Title: POSITION DETERMINATION METHOD AND NAVIGATION DEVICE 

j= (54) Bezeichnung: VERFAHREN ZUR POSITIONSBESTIMMUNG UND NAVIGATIONSGERAT 

== (57) Abstract: The invention 

relates to a position determination 
method according to which, when 
travelling along a curve (K), the 
center of gravity (C d ) of this curve 
is determined from measured 
values of a direction sensor. The 
center of gravity (Cm) of the curve 
(K) of the digitized road (511) is 
determined from the orientation of 
street segments (S) of a digitized 
road, which correspond to positions 
(P d ) determined by means of dead 
reckoning navigation. The positions 
determined by means of dead 
reckoning navigation are corrected 
based on the difference between the 
determined centers of gravity (C d ; 
On) of the curve. 

(57) Zusammenfassung: 

Bei einem Verfahren zur 
Positionsbestimmung wird beim 
Durchlaufen einer Kurve (K) 
deren Kurvenschwerpunkt (Cd) aus 
Messwerten eines Richtungs sensors 
ermittelL Aus der Ausrichtung 
von StraBensegmenten (S) einer 
digital isierten StraBe, die mit 
durch Koppelnavigation ermittelten 

Positionen (Pd) korrespondieren, wird der Kurvenschwerpunkt (Cm) der Kurve (K) der digitalisierten StraBe (511) ermittelt. Die 
durch Koppelnavigation ermittelte Positionen werden auf Grundlage der Differenz zwischen den ermittelten Kurvenschwerpunkten 
(Cd; Cm) korrigiert. 



00 
00 



o 




wo pi/84081 ai i mil iBiiii n Him mil mi i » m iim ran nm mil mi iiiiih im im in 



(84) Bestimmungsstaaten (regional): europaisches Patent (AT, 
BE, CH, CY, DE, DK, ES, FI, FR, GB, GR, IE, IT, LU, MC, 
NL, PT, SE, TR). 

Verdffentlicht: 

— mit internationalem Recherchenbericht 



Zur ErkJdrung der Zweibudistaben-Codes, und der anderen 
Abkurzungen wird auf die ErkJdrungen ("Guidance Notes on 
Codes and Abbreviations") am Anfangjeder reguldren Ausgabe 
der PCT-Gazette verwiesen. 



WO 01/84081 



PCT/DE01/01443 



1 

Beschreibung 

Verfahren zur Positionsbestimmurig und Navigationsgerat 

5 Die Erf indung betrif ft ein Verfahren zur Positionsbestimmurig 
mittels Abgleich einer durch Koppelnavigation ermittelten Po- 
sition mit einer digitalen StraSenkarte und ein Navigations- 
gerat . 

10 Aus der Patentschrif t US 4,796,191 ist bekannt, eine durch 
Koppelnavigation ermittelte Position durch Vergleich mit 
StraSen einer digitalen StraSenkarte zu korrigieren. Hierzu 
wird ein Vergleich zwischen einer von einem Fahrzeug gefahre- 
nen Richtung und der Richtung von Strafien einer digitalen 

15 StraSenkarte durchgef uhrt . Dadurch den Abgleich mit der digi- 
talen StraSenkarte wird eine Summation der auftretenden Mess- 
f ehler der Sensoren verhindert . 

Ferner ist aus dem Patent US 5,394,333 ein Fahrzeugnavigati- 
20 onssystem bekannt, das zur Posit ionsbestimmung Koppelnaviga- 
tion und Satellitennavigation (GPS) einsetzt. Eine durch Kop- 
pelnavigation errechnete Position wird auf eine StraSenkarte 
gezogen. Aus dem Unterschied zwischen der Position in der 
StraSenkarte und einer mittels GPS gefundenen Position wird 
25 ein Korrekturwert fur die GPS -Navigation bestimmt. 

Eine aussagekraftige Positionsbestimmung auf der digitalen 
StraSenkarte kann allerdings nur bei einer signif ikanten 
Richtungsanderung des Fahrzeugs erfolgen, beispielsweise bei 
30 einem Abbiegeman6ver . 

Es ist ein Ziel der Erfindung, ein Verfahren zur Positionsbe- 
stimmung und eine Navigationsvorrichtung bereitzustellen, die 
bereits bei einer leichten Richtungsanderung eine prazise Po- 
35 sit ion auf einer digitalen StraSenkarte bestimmen k6nnen. 

Dieses Ziel wird mit einem Verfahren zur Positionsbestimmung 
und einem Navigationsgerat erreicht, wie sie in den unabhiin- 
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gigen Patentanspruchen definiert sind. Vorteilhafte Weiter- 
bildungen der Erfindung sind Gegenstand der Unteranspruche. 

Es werden" Kurvenschwerpunkte fur eine auf einer Strafie durch- 
5 laufene Kurve, deren Verlauf mittels Koppelnavigation ermit- 
telt wird, und fur eine entsprechende Kurve auf einer Strafie 
einer digitalen Strafienkarte ermittelt. Die Kurvenschwerpunk- 
te sind auch bei lang gezogenen Kurven definierte Punkte, die 
fur einen Abgleich der durch Koppelnavigation gemessenen Po- 
10 sit ion mit der digitalen StraSenkarte zur Verfugung stehen. 
Solche lang gezogenen Kurven haben typischerweise einen Radi- 
us von 500 m bis 1000 m. 

Als Basis fur die Ermittlung der Kurvenschwerpunkte auf der 
15 Karte kann eine Zeitmessung oder eine Entf ernungsmessung die- 
nen. 

Dient als Grundlage fur die Bestimmung der Kurvenschwerpunkte 
eine Zeitmessung, so wird vorteilhaf terweise die Durch- 
20 schnittsgeschwindigkeit beim Durchfahren der Kurve zur Posi- 
tionskorrektur eingesetzt. 

Weitere Vorteile, Merkmale und Anwendungsmoglichkeiten der 
Erfindung ergeben sich aus der nachfolgenden Beschreibung von 
25 Ausfuhrungsbeispielen in Verbindung mit den Zeichnungen. Es 
zeigen: 

Figur 1 ein Fahrzeugnavigationssystem, 

Figur 2 eine in einer digitalen StraSenkarte verzeichnete 
30 Kurve, und 

Figur 3 einen Kurvenschwerpunkt , der auf Grundlage des ge- 
messenen Wegs bestimmt wurde, und eine Kurvenschwer- 
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punkt, der auf Grundlage der entsprechenden Kurve 
der digitalen StraSenkarte bestimmt wurde. 

Figur 1 zeigt ein in einem Kraf tf ahrzeug eingesetztes autono- 
5 mes Navigationssystem 1. Dieses weist eine Recheneinheit oder 
einen Prozessor 11 mit einem Arbeitsspeicher 12 auf. 

Der Prozessor 11 hat Zugriff auf ein Laufwerk 2 fur einen als 
DVD (Digital Versatile Disk) ausgebildeten Kartenspeicher 21. 
10 Auf diesem Speichermedium ist eine Datenbank in Form einer 
digitalen StraSenkarte 51 gespeichert. 

Ferner ist der Prozessor 11 mit einem Entfernungs sensor 3, 
bei dem es sich urn einen Odometer (Tachometer) handelt, und 
15 mit einem Richtungssensor 4 verbunden. Der Richtungssensor 4 
ist ein Gyroskop. 

Zusatzlich ist der Prozessor 11 mit einem nicht dargestellten 
Satellitenempf anger verbunden. Dessen Signale werden eben- 
20 falls zur Positionsermittlung eingesetzt. Der Satellitenemp- 
fanger kann auch alleine die Aufgabe des Entf ernungssensors 3 
und des Richtungssensors 4 ubernehmen.. 

Aufgrund der von den Sensoren und dem Kartenspeicher 21 be- 
25 rechnet der Prozessor 11 eine Fahrzeugposition und gibt diese 
an eine Anzeigeeinrichtung 5 in Form eines Pfeilsymbols aus. 
Die Fahrzeugposition wird auf einer digitalisierten StraSe 
511 der digitalen StraSenkarte 51 dargestellt. 

30 In Figur 2 ist eine in der digitalen StraSenkarte gespeicher- 
te, lang gestreckte Kurve K mit einem Radius von 750 m veran- 
schaulicht. Diese Kurve K ist ein Abschnitt einer digitali- 
sierten StraSe, die durch Knoten (Nodes) definiert ist. Diese 
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Knot en beschreiben regelmafiig Strafienkreuzungen und beinhal- 
ten Angaben uber die Entfernung und die Richtung zum nachsten 
Knoten. Kurvenverlauf e werden ebenfalls durch aufeinanderf ol- 
gende Knoten definiert. Diese werden im allgemeinen als Ges- 
5 taltungspunkte (Shape Points) bezeichnet. 

Der Verlauf der dargestellten Kurve wird durch die Gestal- 
tungspunkte N Q bis N n definiert . Zwischen zwei Knoten Oder 
Gestaltungspunkten erstreckt sich jeweils ein StraSensegment 
10 S. 

In die Kurve K sind mehrere Fahrzeugpositionen wahrend des 
Befahrens .der Kurve eingetragen. Dabei bezeichnen P* eine 
durch Koppelnavigation aufgrund von Entf ernungsmessungen und 
15 Richtungsmessungen auf der digitalen StraSenkarte ermittelte 
Position und P m eine tatsachliche, wirkliche Position, die 
dem Navigationsgerat zunachst unbekannt ist. 

Aus der Darstellung ergibt sich, dass aufgrund eines Langen- 
20 fehlers, die berechnete Position Pa vor der realen Position 
P m angenommen wird. Zu einem ersten Zeitpunkt befinden sich 
beide Positionen Pa und P m auf dem Strafiensegment S zwischen 
den Gestaltungspunkten N 0 und N x . Zu einem zweiten Zeitpunkt 
befindet sich das Fahrzeug in Wirklichkeit noch in demselben 
25 StraSensegment S, wahrend nach der fehlerhaften Lingenmessung 
das Fahrzeug bereits eine Kurvenfahrt zwischen den Gestal- 
tungspunkten Ni und N 2 beschreiben musste. Am Ende der Kurve 
K befindet sich das Fahrzeug in Wirklichkeit noch in der Kur- 
ve, wahrend das Fahrzeug nach der vom Entf ernungsmesser ge- 
30 messenen Entfernung oder Distanz die Kurve bereits verlassen 
haben musste. 
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Der Kurvenverlauf weist keine signifikante Richtungsanderung 
innerhalb weniger Meter auf , so daas eine eindeutige Zuord- 
nung eines Punkts der gemessenen, durchlauf enen Kurve zu ei- 
nem Punkt der digital islerten Kurve der digitalen StraSenkar- 
5 te nicht moglich ist. Es ist jedoch moglich, aufgrund eines 
Vergleichs zwischen den vom Richtungs sensor ausgegebenen Win- 
kelanderungen und der Ausrichtung der StraSensegmente S fest- 
zustellen, ob die vom Navigationsgerat berechnete Position Pd 
der wahren Position voraus eilt oder hinterher hinkt. 

10 

Urn dennoch eine eindeutige punktuelle Zuordnung zwischen dem 
gemessenen Pfad und der digitalen StraSenkarte vorzunehmen, 
wird der Kurvenschwerpunkt des gemessenen Pfads aus den Mess- 
werten der Sensoren und der Kurvenschwerpunkt der in der di- 
15 gitalen StraSenkarte verzeichneten Kurve K aus der Ausrich- 
tung der StraSensegmente S ermittelt. 

Figur 3 zeigt ein Diagramm f in dem liber eine Zeitachse die 
diskreten Winkelanderungen A<p sowohl entsprechend den Sen- 
20 sormesswerten (weii3e Balken) als auch entsprechend eiher di- 
gitalen StraSenkarte aufgetragen sind. AuSerdem sind die Kur- 
venschwerpunkt e C d und C m fur die gemessene Kurve und fur die 
digitalisierte Kurve der StraSenkarte aufgetragen. 

25 Der Kurvenschwerpunkt Cd des durchf ahrenen Pfads wird ermit- 
telt , indem die einzelnen Richtungsanderungen A<p aus aufein- 
anderfolgenden Richtungsmessungen gewonnen und jeweils mit 
der verstrichenen Zeit t gewichtet und addiert werden. Diese 
Summe wird dann durch die Summe der gemessenen Richtungsande- 

30 rungen dividiert. 

Der Kurvenschwerpunkt C m der in der digitalen StraSenkarte 
verzeichneten Kurve wird ermittelt, indem die Differenzen der 
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Winkel Aq> aufeinanderfolgender StraSensegmente in ihrer Auf- 
einanderfolge mit der jeweils verstrichenen Zeit t gewichtet 
werden, die beim Verfolgen der StraSensegmente auf der digi- 
talen StraEenkarte verstrichen ist. Die so erhaltenen Werte 
werden addiert. Diese Summe wird durch die Summe der Diffe- 
renzen der Winkel Acp der auf einanderfolgenden StraSensegmen- 
te dividiert. 

Es gilt: 



10 



£ i*(<pd,i+l-<pd ,i) Z i\(pm,M-(pm,i) 

Cd= M und Cm=^ n 

n n 

£ (<Pd,i+l-(pdj) £ {<Pm,i+l-<Pm,i) 

i=0 1-0 



diskreter Zeitpunkt, 

Anzahl der diskreten Zeitpunkte (Kurvendauer) , 
gemessene Ausrichtung des Fahrzeugs zum Zeitpunkt i, 
Ausrichtung des StraSensegments zum Zeitpunkt i, 
Kurvenschwerpunkt der vom Fahrzeug durchlauf enen 
Kurve # und 

Kurvenschwerpunkt der Kurve der digitalisierten 
StraSe. 

Die Kurvenschwerpunkte C d und Cm, bei denen es sich urn Zeit- 
punkte handelt, werden anschliefiend in eine Wegdifferenz oder 
25 Distanz umgerechnet, mit der die Entf ernungsmessung korri- 

giert wird. Da die Geschwindigkeit wahrend einer Kurvendurch- 
fahrt haufig nicht konstant ist, wird hierzu eine Durch- 
schnittsgeschwindigkeit verwendet. Diese wird dann mit dem 



wobei : 
i 

15 n 
<Pd,i 

9m, i 

C d 

20 C m 
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zeitlichen Abstand (Cd-Qn) zwischen den Kurvenschwerpunkten 



multipliziert . 



Die Wegdif f erenz, also der Langenf ehler oder Korrekturwert 
5 lasst sich wie folgt berechnen: 



& = (Ci-Cm)* 1 ^- , wobei 



i diskreter Zeitpunkt, 

10 n Anzahl der diskreten Zeitpunkte (Kurvendauer) , 

Cd Kurvenschwerpunkt der vom Fahrzeug durchlauf enen 

Kurve , 

C ra Kurvenschwerpunkt der Kurve der digital isierten 

StraSe, 

15 vi Geschwindigkeit zum Zeitpunkt i, und 

5 3 Distanz zwischen der gemessenen und der tatsachli- 

chen Position. 

Werden die Kurvenschwerpunkte dagegen auf Grundlage des zu- 
20 ruckgelegten, vom Entf ernungssensor gemessenen Wegs bestimmt, 
so erhalt man den Likngenfehler unmittelbar aus der Differenz 
der Kurvenschwerpunkte. 

Die berechnete Distanz 8 Q wird in mehrere Teilstrecken ge- 
25 teilt und nacheinander zu der jeweils aufgrund der Sensorda- 
ten berechneten Position Pa addiert beziehungsweise subtra- 
hiert. Damit wird erreicht, dass die Position P d allmahlich 
der tatsachlichen Position P m angenahert wird und eine 
sprunghafte Andenang der Darstellung in der Anzeigeeinrich- 
30 tung vermieden wird. 
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Patentanspruche 

1. Verfahren zur Positionsbestimmung mittels Abgleich einer 
durch Koppelnavigation ermittelten Position (Pd) mit einer 

5 digit alen StraSenkarte (51) mit den Schritten: 

- eine Auf einanderf olge von durch Koppelnavigation ermittel- 
ten Positionen (P d ) wird auf digitalisierten StraSen (511) 
der digitalen StraSenkarte (51) verfolgt und StraSensegmen- 
ten (S) der digitalen StraSenkarte (51) zugeordnet, 

10 - beim Durchlaufen einer Kurve (K) wird der Kurvenschwerpunkt 
(Ca) der Kurve (K) aus Messwerten eines Richtungssensors 
(4) ermittelt, 

- aus der Ausrichtung von StraSensegmenten (S) einer digita- 
lisierten StraSe (511) , die mit den ermittelten Positionen 

15 (P d ) korrespondiert , wird der Kurvenschwerpunkt (C m ) der 
Kurve (K) der digitalisierten StraSe (511) ermittelt, 

- die durch Koppelnavigation ermittelte Position wird auf 
Grundlage der Dif ferenz zwischen den ermittelten Kurven- 
schwerpunkten (C d ; Cm) korrigiert. 

20 

2. Verfahren nach Anspruch 1, dadurch gekennzeichnet, dass 
der Kurvenschwerpunkt (CJ der in der digitalen StraSenkarte 
(51) verzeichneten Kurve (K) berechnet wird, indem die Diffe- 
renzen der Winkel (Aq>) auf einanderfolgender StraSensegmente 

25 (S) in ihrer Auf einanderfolge gewichtet und addiert werden 
und die so ermittelte Summe durch die Summe der Differenzen 
der Winkel (Aq>) der aufeinanderfolgenden StraSensegmente (S) 
dividiert werden. 

30 3. Verfahren nach dem vorhergehenden Anspruch, dadurch ge- 
kennzeichnet , dass die Differenzen der Winkel (A<p) aus Ges- 
taltungspunkten (N) bestimmt werden, die die StraSensegmente 
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(S) der Kurve (K) definieren, und dass die Differenzen der 
Winkel (A<p) mit dem zeitlichen Abstand gewichtet werden, der 
beim Verfolgen der Strafiensegmente (S) auf der digit alen 
Strafienkarte (51) verstrichen ist. 

5 

4. Verfahren nach dem vorhergehenden Anspruch, dadurch ge- 
kennzeichnet, dass die Durchschnittsgeschwindigkeit beim 
Durchlaufen der Kurve (K) ermittelt wird # und dass der zeit- 
liche Abstand zwischen dem Durchlaufen der Kurvenschwerpunkte 

10 (Cd; C m ) mit der Durchschnittsgeschwindikeit multipliziert 
wird, urn die durch Koppelnavigation ermittelte Position (P d ) 
mit der so gewonnenen Distanz zu korrigieren. 

5. Navigationsgerat, das aufweist: 
15 - einen Entfernungssensor (3), 

- einen Richtungssensor (4) , 

- einen Kartenspei cher (21) fur eine digitale Strafienkarte 
(51), 

- wenigstens einen Prozessor (11) zur Koppelnavigation, 

20 der mit dem Entfernungssensor (3), dem Richtungssensor (4) 
und dem Kartenspeicher (21) verbunden ist, 
der beim Durchlaufen einer Kurve (K) deren Kurvenschwer- 
punkt (Cd) aus Messwerten des Richtungssensors (4) ermit- 
telt, 

25 der aus der Ausrichtung von Strafiensegmenten (S) einer di- 
gitalisierten Strafie (511) , die mit den ermittelten Positi- 
onen (Pd) korrespondiert, den Kurvenschwerpunkt (C m ) der 
Kurve (K) der digitalisierten Strafie (511) ermittelt, und 
der die durch Koppelnavigation ermittelte Position auf 

30 Grundlage der Differenz zwischen den ermittelten Kurven- 
schwerpunkten (C d ; C m ) korrigiert. 
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FIG 2 
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